#include "../inc/squat.h"
#include "../inc/queue.h"
#include "../inc/calculate.h"

#define MODEL_NUMBER_SQUAT 3
uchar angles_squat[MODEL_NUMBER_SQUAT][DJ_AMOUNT]=
	{
	 {  0,  0,  0,  0, 0,  0, 20,168,138,145, 95,103,100,107, 25,22},
	 {  0,  0,  0,  0, 0,  0, 20,168,145,152, 25, 33,153,160, 25,22},
	 {  0,  0,  0,  0, 0,  0, 20,168,150,157,  5,  13,168,175, 25, 22}
	};

uint insert_number_squat[MODEL_NUMBER_SQUAT]=
	{0,150,30};

void squat()
{
	uchar i;
	insert_number_squat[0]=calculate_insert_number(queue_angles[queue_head],angles_squat[0]);

	queue_tail=queue_head;

	for(i=0;i<MODEL_NUMBER_SQUAT;i++)
		enqueue(angles_squat[i], insert_number_squat[i]);
}
